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Project Summary 


A major problem in space applications of robotics and docking of spacecraft 
is the development of technology for automated precise positioning of mating com- 
ponents with smooth motion and soft contact. To achieve the above objective, a 
design method has been developed for optimally placing the closed-loop poles of a 
discretized robotic control system at exact prescribed loctions inside the unit circle 
of the complex z-plane. The design method combines the merits of the pole place- 
ment and the linear quadratic design approaches. The proposed design procedure 
is based on the assignment of one real eigenvalue or two complex conjugate (or real) 
eigenvalues at each design step. The method involves solutions of simple algebraic 
equations and thus is considered to be efficient for on-line or off-line computations. 
Also, in this project, two methods for the linearization of nonlinear model of a 
robotic manipulator have been presented. 

Since automatic control of multi-degree freedom robotic manipulators involves 
high nonlinear equations of systems, we propose a pilot project involving the control 
of an one-dimensional system. This simple system can be readily implemented for 
testing the concepts and algorithms. The ideas developed in this project will provide 
proven principles for the development of the use of froce/torque sensors for robotic 
manipulators with more than one joint. 

Based on the research results in the period of January 1987 to June 1987, five 
papers have been accepted for publication in the referred journals [16,17,18 ], and 

presentation at the 1987 Automatic Control Conference 
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Current Work by the Investigators 


1. Introduction 

The dynamic characteristics of a linear system are influenced by the locations 
of its poles. Therefore, for a system to exhibit good response, both in the transient 
and steady states, it is necessary to place the closed- loop poles in desired positions. 
The design of discrete optimal control systems with prescribed eigenvalues has been 
studied by Solheim [1]. Solheim [l] stated that it is not, in general, possible to 
determine the resultant state weighting matrix Q for the discrete-time systems. To 
overcome the drawbacks, Amin [2] modified the recursive approach of Solheim [l] to 
guarantee the existence of the resultant Q. Both of the procedures involves solution 
of the discrete-time algebraic Riccati equation at each design step. 

In this project, an optimal pole placement method is presented for the design 
of computer control systems for robotic manipulators that are modeled by highly 
coupled, nonlinear systems of equations. Two methods of linearization have been 
considered: 

(1) One is based upon feedforward cancellation of the gravity terms and piecewise 
constant parameterization. 

(2) The other is based upon the use of perturbation equations associated with a 
nominal trajectory. 

This project is organized as follows: 

Section 2 contains a brief review of the equations of motion for a robotic manip- 
ulator. Linearization techniques for a robotic manipulator are presented in Section 
3. Finally, Section 4 presents discrete linear regulators with prescribed eigenvalues. 

2 Equations of Motion 

By applying either the Newton-Euler or the Lagrange’s equations, the equations 
of motion for a robotic manipulator with n joints can be obtained and written in 
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vector-matrix notation as 


D(q)q + h(q, q) + g(q) = r(t) (1) 

where 

r is an n x 1 vector of forces or torques applied to links, 

q, q, q are nxl vectors representing joint positions, 

velocities and accelerations, 

D[q) is an n x n generalized mass matrix, 

h(q,q) is an n x 1 vector of Coriolis and centrifugal acceleration 

terms, and 

g{q) is an n x 1 vector representing the effects of gravity. 

The effects of viscous friction acting on the links can be taken into account by 
adding a term Vq to Eq. (1) to get 

D{q)q + Vq+h{q,q) + g{q)=r(t) (2) 

where V is an n x n diagonal matrix containing the coefficients of friction for each 
joint. 

We will now consider the effect of including the dynamics of the actuators. 
Assume that all joints are revolute and that each joint is driven by a DC servo motor 
through a gear chain. With the assumption that the armature-winding inductance 
is negligible and that the DC motors are operated in their linear range, i.e., the 
torque delivered by the motor is proportional to the armature-winding current by 
a constant Kt, the dynamic equations of the actuators can be written as 

v = K b 0 a + RK^ra (3a) 

and 

T a - T ' = J a 0 a + Bj a (36) 
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where 


v is an n x X vector of applied armature voltages, 

r a is an n x 1 vector of torques delivered by the DC motors, 

t' is an n x 1 vector of torques applied by the links to the actuators, 

9 C i,9 ay 9 a are n x 1 vectors representing the angular positions, velocities 

and accelerations of the actuators shafts, 

J a ,B a are n x n diagonal matrices representing the moment of 

inertia and the viscous friction coefficients of the actuators, and 
R,Kb,Kt are n x n diagonal matrices representing the 

armature-winding resistances, the back EMF constants 
and the torque constants of the DC motors. 

Assuming that the gear backlash is negligible, we can write 


r' = N~ l r 

(4a) 

e a = N„q 

(46) 

K = N g q 

(4c) 

9 a = N g q 

(4d) 

where N g is defined as an n x n constant diagonal matrix with each diagonal element 
specifying the corresponding joint gear ratio. 

Using Eqs. (l)-(4), the dynamic equations for a robotic system including the 
dynamics of the actuators can be written as 

D' (q)q + V'q + h,'{q, q) + = v(t) 

(5a) 

where 

D\q) = RK;'\N g Ja + N~ l D{q)) 

(56) 

V' = N g Kb + RK; l \N g B a + N-'V] 

(5c) 
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k'(q,q) = RKr'N- l k(q,q) 


M 


and 


»'(«) = RKr'N-'g(q) 


(5e) 


3. Methods of Linearisation 

Two methods of linearization of a highly coupled nonlinear robotic control 
system are considered. The first method is based upon the feedforward cancellation 
of the gravity terms and the piecewise parameterization, while the second method is 
based upon the perturbation equations associated with a given nominal trajectory. 

3.1 Cancellation of Gravity Terms 

For simplicity, the dynamics of the actuators are neglected; however, the method 
is applicable even if the dynamic equation of the overall system including the actu- 
ator is used because of the structure of that equation. Note that the Coriolis and 
centrifugal term h(q,q) is a quadratic vector form of q (see Raibert and Horn [3]). 
Hence this term can be expressed as 

h(q,q) = E(q,q)q (6) 

where E(q,q) is defined as an n x n matrix. The dynamical equation of the robotic 
system in Eq. (2) can be rewritten as 

D(q)q + [V + E(q, q)]q = r - g{q) (7a) 

or 

q = -D- 1 («)[V + E(q,q)\q + D~'(q ) [r - }(«)| (76) 

Eq. (7) can be written in the state-space representation as 

x(t) = A(«)x(<) + b(t)u(t) (8a) 
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where 



and 

x T (t) = |« r (<M T (<)], «(t) = <•(()- 9kW) M 

The linearized dynamic equations of a robotic system can be computed at each 
sampling period where the nominal trajectory is known, i.e, the joint position q(t) 
and the velocity q(t) are given. Thus, the control problem can be considered as a 
time-varying control problem. 

Remark 1 For the implementation of a controller using this approach, a discrete- 
time model should be used instead of the continuous-time model. Also, assuming 
that D(q) and E(q,q) are piecewise constant, the system in Eq. (8) is a system of 
type 1 with the input u(t) = r(t)—g(t). Thus if the computed system parameters are 
exactly the same as the true ones, the elimination of the steady state position error 
will be assured by the use of state-feedback control law, but not for the position 
error when the set point is a ramp input (i.e., the manipulator is programmed to 
move at constant velocity). In order to eliminate such errors, integral control may 
be applied. 

3.2 Perturbation Equations 

For simplicity, the dynamics of the actuators are omitted in the derivation of 
the perturbation equations; however, the results can be easily extended to include 
the actuators dynamics of the DC motors. 

Suppose that the desired trajectory in the task-space (world space) of the hand 
(the gripper) of a manipulator is preplanned. The corresponding trajectory includ- 
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ing q*{t),q*(t) and q*(t) can be precomputed as well as the nominal applied torque 
r*(t) (or voltage v*(t)) required for motion along the specified trajectory. 

The dynamical equations in Eq. (2) can be expressed as a sum of the nominal 
equation, 


D(q*)q* + V? + h(q\f) + ff(q') = r*(t) 


plus a perturbation equation, 


( 9 ) 


6{Dq)+V6q+6h + 6g = 6r 


( 10 ) 


The variations 6(Dq),6h, and 6g can be expressed in terms of the following linear 
approximations, 



6[D(q)q] = + B(t)q 

(hi) 


6h{q,q) = C(t)6q + E{t)6q 

(116) 


6g{q) = F{t)6q 

(He) 

where 


(12a) 


to-***. 

(126) 



(12c) 



(12<0 

and 

™ 

(12c) 

Note that the (*,/) element of the matrix A is found as 



2 _ d Efc=l D ik9k. 

lJ ~ dqj ~ q ,q 

(13a) 
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Therefore, the perturbation equations for the manipulator can be approximated as 


D{t)6q + P[t)6q + Q[t)6q = 6r 


(14) 


where 


and 


P{t) = V + E(t) 


Q(t) = A(t) + C(t) + F(t) 


(15a) 


(156) 


Thus, the equivalent state-space representation of the manipulator dynamics be- 
comes 


Sx(t) = A(t)Sx(t) + B(t)6r(t) 


where 


x = [69i,692>'*-,6q„,6?i,692>'*',69n] T 

Mt) = 


On fn 

-D~ 1 Q(t) -D~ 1 P(t) 


and 


m = 


0 » 1 

D-'Q(t) \ 


(16) 

(17a) 

(176) 

(17c) 


Consider the linear state-feedback control law for the system in Eq. (16) as 


6r(t) = -K(t)6z(t) 


(18a) 


The total input torque becomes 


r(t) = r*(t) + 6r(t) 


(186) 


Note that there are several design methods available in the literature for choos- 
ing the appropriate feedback gain K [4,5]. 


Remark 2 An important advantage of linear state-feedback control based on the 
linearized perturbation equations is that when the desired trajectory is preplanned, 
the feedback gain matrix K can be computed off-line and stored in a table. On the 
other hand, the parameterization approach does not require any prior knowledge of 
the path, but the system parameters must be either computed on-line or stored in 
a look-up table based upon segmentation of the workspace. 

4 Discrete Linear Regulators with Prescribed Eigenvalues 

This section deals with the design of linear discrete regulators with prescribed 
eigenvalues. The discrete optimal pole placement methods have been discussed by 
Solheim [6], Amin [2] and others [7]. However, these methods are based on the 
solution of the algebraic discrete Riccati equation. In this section, a design method 
for the synthesis of discrete optimal control systems with prescribed eigenvalues 
is presented. The proposed method is based on the solution of simple algebraic 
equations and thus is considered to be computationally efficient. 

Consider the linear time-invariant controllable system described by 

x(k + 1) = Gx{k) + Hu(k); x(0) (19a) 

y(k) = Cx(k) (196) 

where x(k) and u(fc) are the n x 1 state and m x 1 input vectors, respectively, and 

G, H and C are constant matrices of appropriate dimensions. Assume that the 
system matrix G is nonsingular. 

The main objective is to find a feedback control law, 

u{k) = -Fx{k) (20) 

which gives the closed-loop system a set of desired eigenvalues and at the same time 
minimizes the quadratic performance index, 

J = 5^[x r (j)(?x(t) + u T (i)Ru{i)\ (21) 

i=0 
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where Q and R are nonnegative and positive-definite symmetric matrices, respec- 
tively. 

Applying the controller in Eq. (20) to the system in Eq. (19), the closed-loop 
system becomes 

x(k + 1) = (G - ffF)x(fc) = G c x(Jb) (22) 

The optimal control law in Eq. (20) that minimizes the performance index in Eq. 
(21) is given by 


u{k) = -{R + H T PH)~ l H T PGx(k) = —Fx(k) (23a) 


with 


F = {R + H t PH)- 1 H t PG 


(236) 


or 

F = R~ 1 H T (P- 1 + HR~ 1 H t )- 1 G (23c) 

where the P is positive definite matrix and is obtained by solving the discrete 
algebraic Riccati equation, 


P = G t PG - G t PH(R + H T PH)~ l H T PG + Q (23 d) 


The approach here is how to choose Q and R such that the closed-loop system 
in Eq. (22) has a set of prescribed eigenvalues. Similar to Solheim’s method [6], 
a recursive procedure is developed. Also, the technique of modifying the input 
control weighting matrix R as in Amin’s method [2] is considered in order to assure 
optimallity of the closed- loop system. Before presenting the new method, some 
preliminary results are needed. 
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Lemma 1 [2] Given a controllable system as in Eq. (19) and the performance index 
in Eq. (21) with the control weighting R. Assume that j feedbacks are obtained 
for j recursive optimal problems with 


G i+l =Gi-HFi , G 1 = G 


(24) 


If the control weighting matrix Ri satisfies the condition, 


R i+1 =Ri + H T PiH, R X =R 


(25) 


then the feedback control matrix, 




t=i 


is the solution of the optimal control problem with weighting matrices, 


(26) 


<? = £>, R = R 

1=1 


(27) 


Furthermore, the solution P of the equivalent discrete Riccati equation becomes 

j 


i=l 


(28) 


Lemma 2 Consider the controllable system 


x(k + 1) = Gx(k) + Hu(k) 


(29a) 


where H is a 2 x m matrix and G is a 2 x 2 matrix defined by 


G = 


9\ 9 2 

93 94 


(296) 


Then, the closed-loop system obtained by solving the optimal control problem for 
a set of Q and R can be expressed as 

G C = G-HF = G- HR~ 1 H t {P ~ 1 + HR~ 1 H T )~ 1 G = DG (30) 
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where D is defined as the lower triangular matrix, 


0 

II 

Q 

(31) 

Also, if det(G c ) is chosen such that 


0 < det{G c )/det{G) < 1 

(32) 

then, the elements of the matrix D are calculated from 


det(G c ) = det(D)det(G) 

(33a) 

tr(G c ) = tr(DG) 

(336) 

or 


= det(G c )/det(G) 

(33c) 

9\d\ + <? 2<?2 + 94^3 = tr{G c ) 

(33d) 


with and dz(di ^ J 3 ) to be chosen as positive numbers less than one. 


Lemma 3 Consider the system as in Lemma 2 . Let a lower triangular matrix D be 
defined as 


D = I 2 ~D = 


d 1 
C?2 



(34) 


where D is obtained from Lemma 2 . Then, there exists a lower triangular trans 
formation T t such that 



D = t . at - 1 

(35a) 

where 






A = diag{d\, d$] 

(356) 

and 


1 o' 

a 0 


(35c) 

with 0^0 and 

a — — 

*2 


(35d) 


d\ — dz 



12 


Lemma 4 Consider the system as in Lemmas 2 and 3. For a given positive definite 
R, there exists a P matrix such as 


P = T- T k p T~ x 


where 


A P = (A2 1 -A r )- 1 


with A r chosen to be a diagonal matrix such that 
HR~ X H T = T'k r Tj = T , 


An 0 
0 A r 2 


Tj 


(36a) 


(366) 


(36c) 


and 


A 2 A r — A 


(36d) 


Proof: From Eqs. (30) and (34), we can write 

HR~ X H T {P~ X + HR~ 1 H t )~ 1 = D = T e kT~ l = T t K r Tj T~ t k 2 T~ l (37a) 


Therefore, we can write 

HR-'H 7 ' = T e k r Tj 


and 


(p- 1 + hr- 1 h t )~ x = r- T A 2 r a - 1 


The right hand side of Eq. (37b) can be rewritten as 


T»k r Tj = 


An Ana 

A r ja Ana 2 + A r2 /? 2 


Let 


HR~ l H T = 


fi 

?2 


f2 

fz 


Solving for a,f3,\ r \ and A r 2 from Eqs. (37d) and (37e), we get 


Ari — fj, 



\r2@ 2 


det{HR~ l H T ) 
f 1 


(376) 

(37c) 

(37d) 

(37c) 

(37/) 
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Furthermore, using Eqs. (37a), (37b) and (37c), we get 


P = T~ t K p T~ 1 (37c) 

with A p given by Eq. (36b) and T s given by Eq. (35c). 

Lemma 5 Consider the system as in Lemmas 2 and 3. Also, consider the similarity 
transformation matrix Td given by 

l! ! ] < 38 ‘> 

Let 

hr-'h t = '* , t;'hr-'h t t; t £ [£ £] (386) 

Also, let 

G = T^GT d = f? 1 ? 2 1 (38c) 

[g3 

where 

91 — + 03*2*4 — *3(g2*l + £4*2)] (38d) 

92 = rf c f(r d ) (~^i*i *2 ~ 93*1 + 92*1 + 94 * 1 * 2 ) (38e) 

n = ^(r d) l( r + 2r 2 *i *2 + r 3 *l) (38/) 

and 

?2 = ~[et{T^ "*■ f2 * 2 ) *”2*1*4 + »"3<2<4] (38<?) 

Then, for Eq. (33d) to hold and T t in Eq. (37) to exist, we choose f 3 = 0, = 0 

and <2 in Eq. (38a) to satisfy the following equation, 

*2 + &i<2 + 62 = 0. (38h) 


where 

. *l( r 103 + t J92) 

1 ~ - v) 


(38t) 
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and 


b 2 = 


*iMgi -»)] 

*•3(04 ~ v ) 


(38j) 


with 


_ jl-d 3 )tr{G)-tr{G e ) 
di — dz 


(38fc) 


satisfying the following equation, 


min{gi,g 4 ) <v< max{gi,g 4 } 


(38/) 


Proof: Equation (33d) can be rewritten as 

(1 - <Z 3 )tr(G) - tr(Ge) a 


gi = -<*02 + 


d\ — dz 


-otgz + v 


(38m) 


Using the transformation Td, Eq. (38m) becomes 


01 = -<*02 + v 


(38n) 


Substituting for 0i,02)<* and v in Eq. (38n), Eq. (38n) can be rewritten as 

tj + ^1^2 "b bz = 0. (38o) 

with 61 and 62 as given by Eqs. (38*) and (38j), respectively. Note that tz in Eq. 
(38o) exists for any values of t\ and <4 provided that v in Eq. (38A;) satisfies Eq. 
(38/). 

Theorem 1 Consider the system as in Lemmas 2, 3, 4 and 5. Let the input matrix 
H has rank equal to 2. Then, there exists a lower triangular matrix P(= J2 — D), 
given by Lemma 2, that places the closed-loop eigenvalues at prescribed values and 
causes the state weighting matrix, 

Q = T d r QTj' (39 a) 
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with 


Q = P - G t PG + G t D t PG = P- G t {I - D t )PG (396) 

to be positive semi-definite provided that Eq. (32) holds, and the optimal control 
law becomes 


u{k) = —Fx(k) = —R~ 1 H T (P~ l + HR~ l H T )~ 1 Gx(k) (39 c) 


with 


P = T d T PT d l 


(39a) 


Proof: Using the transformation T&, the right hand side of Eq. (37b) can be rewrit- 
ten as 


T.krTj = 


A r l A r ia 

Afi a A r ia 2 "f 


Let 


A A 

r i r 2 

A A 

r 2 r 3 


T d 1 HR- 1 H T T d T = R = 

Solving for a,/?,A r i and A r2 from Eqs. (40) and (41), we get 


A r i — fi, a — A , A r 2P — a 

r\ T\ 


Therefore, by using Eq. (42) and Lemma 4, P can be expressed as 

+ a 2 -a 


P = 


v 


r det (R)u ^ 2 


Xr20 2 [ 




—a 


(40) 


(41) 


(42) 


(43) 


Substituting for P from Eq. (43) and D from Eq. (35a) into Eq. (396), we get 

G} (44a) 




where 


■^ + a’ -o' 

h-i 

eo 1 
1 

1 


—a 1 . 

t; 

-a 1 . 

d i 

dz 

G = T d 1 GTd 

u i - <h ’ v _ 

" 1 - d z ' 


(446) 
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It is seen that Td in Eq. (44) can be chosen to satisfy Eq. (38 h) and to make Q a 
positive semi-definite matrix. 

From Eqs. (23) and (43), the optimal control law associated with R and Q in 
Eq. (39a) can be written as 

u(Jfc) = —Fx(k) = -R- l H T (P~ l + HR~' H T )~ l Gx{k) (44 c) 


Corollary^ 1 Given a controllable system as in Lemma 2 with the input matrix H 
having a rank of one. If d\ in D is chosen as zero and d$ is chosen to satisfy Eq. 
(33c), an optimal closed-loop system with prescribed eigenvalues can be obtained 
provided that the closed- loop eigenavlues satisfy Eq. (32). 


Proof: Since H has a rank of one, it can be transformed to the following structure, 


H = 


Oixm 
hi xm 


(45a) 


To assure that P is a positive definite matrix, A 2 in Eq. (366) can be written as 


A 2 = diag[w, - — ], for w > 0 
A r 2 


(456) 


Then, the corollary can be proved in a similar manner to Theorem 1. 


Corollary 2 Consider the controllable system in Eq. (19) where G and H are given 
as A = Ajxi and H = hi xm - Let D = d(> 0) and R > 0) and the desired closed- 
loop eigenvalue be A. The closed- loop system G c has A and is optimal with respect 
to R and 

Q = q = p — AAp > 0 (46a) 

provided that the closed-loop eigenvalue A is chosen such that 

0 < AA < 1 (466) 
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Design Procedures 


Consider the following controllable open-loop system described as 

x(k + X) = Gx(fc) + #u(A:) (47) 

Step 1 : 

Find a transformation marix M\ such that the given system matrix G can be 
converted to a block-diagonal form [8] as shown below: 

Mi'GMi = block - diag\G k , G*_! , • • • , G x ] = G (48a) 

where each G, is either a 2 x 2 or 1 x 1 block. Also, compute 

m;'h = t h ( 48 ») 

Step 2 : 

Set i = 1, and initialize the feedback gain K and the matrices R\, P and Q as 
shown below. 

K — Om x n > — P-t P — On) Q = On (49) 

Step 3 : 

Assign the closed-loop poles to satisfy the requirements in Theorem 1 with 
Ri+i — Ri + H T P{H[Ri = R) and compute the feedback control F, from Eq. (44c) 
and the state weighting matrix Qi from Eq. (44a) using the pair ( Gi,Hi ). 

Step 4 : 

Compute 


P = A/f T [block - diag\O n - ni ,Pi]}Mi 1 

(50a) 

Q = Q + Mi T [block - dtay[O n -n. , Qt]]Aff 1 

(506) 

P = P + P 

(50c) 

K = K + (R + H T PH)~ l H T PG 

(50d) 
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(50c) 


G = e-fi[0 mx(n . nj) ,F,]= G * £ 

Step 5 : 

Block-diagonalize the partially designed system matrix in Eq. (50b) and move 
the last block of G, i.e., G ct to the first block and accumulate the transformations 
in Mi = Mi M 2 to compute the new system matrix and input matrix as 

<5 = Mj-'GMj = G 0 " ?. (51a) 

and 

H = M^H = (fff, ( H 2 - LiHi) T ] T (516) 

The transformation M 2 is of the form, 



The matrix L, can be obtained by solving the following Lyapunov equation, 

G{Lx — LiG C i ■+■ Wi = 0( n _ ni ) xnj (51d) 

Step 6 : 

Set » = * + 1. If t > k, stop, else go to step 3 
Project Description 

Since automatic control of multi-degree freedom robotic manipulators involves 
high order nonlinear equation of systems, we propose a pilot project involving the 
control one-dimensional system. This simple system can be readily implemented 
for testing the concepts and the algorithm. 

The method to design a computer control system for the one-dimensional sim- 
plified mechanical model shown in Fig. 1 is presented in this section. The control 
law will be designed to position mass m 2 precisely adjacent to the barrier so that 
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the reaction force from the wall is minimum. The mass mi represents the inertia of 
the manipulator while m 2 represents the mass of the end effector plus that of the 
object being positioned. The spring represents the compliance of the system. The 
system is driven by a linear motor that is equipped with a linear optical encoder for 
measurement of position. The force transmitted from the spring to mass mi will 
be measured using a force/torque sensor. 

The equations of motion for the mechanical system shown in Fig. 2 can be 
written as 


miii + cii + fc(zi - x 2 ) = u(t) 

(52a) 

m 2 i 2 + CX 2 — k(x 1 — Z 2 ) = 0 for xi < d 

(526) 

2 rri 2 X 2 = I for X 2 = d 

(52c) 

where c is the coefficient of friction and k is the spring constant. 
Considering the motor dynamics, we get 

v a = kbi 1 + Ri 

(53a) 

where kb is defined as the back EMF motor constant and v a is 

the motor input 

voltage. Also, 

* •* 
•** 
•4S 

II 

"3" 

(536) 


where kt is the motor torque constant. 

The idea developed in this project will provide proven principles for the devel- 
opment of the use of force/torque sensors for robotic manipulators with more than 
one joint. 
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Figure 1 Mechanical System Representation 



Figure 2 Block Diagram Representation of the Mechanical System 
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Discussion 


The proposed problem represents the simplification to the one-dimensional case 
of precision positioning of an object. This is a pilot project to provide an investi- 
gation of the use of force sensor information in closed-loop controller design. The 
project will provide for the development of concepts that can be extended to general 
docking and assembly operations in space. In follow-on work the problem can be 
extended to the design of a control system for a multi-degree freedom manipulator 
using feedback from a force/torque sensor. This feedback will be determined by 
optimally placing the closed-loop poles of a discretized robotic control system at 
prescribed locations. 

The advantage of incorporating force/torque sensor information in the closed- 
loop control design is that precise but soft positioning can be achieved in a smooth 
motion without generation of large forces resulting from mating of parts of docking 
operation. 
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